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ABSTRACT 

Tracking  Theater  Ballistic  Missiles  (TBMs) 
during  boost  phase  is  becoming  a  requirement 
for  some  engagement  strategies.  The  require¬ 
ment  for  boost  phase  tracking  can  be  based  on 
the  needs  of  an  early  launch  doctrine  or  can  be 
motivated  by  the  availability  of  a  cue  provided 
by  an  airborne  search  and  track  infrared/laser 
system.  The  standard  filters  such  as  a  —  (3  or 
a  —  /3  —  7,  require  that  the  target  being  tracked 
have,  respectively,  constant  velocity  or  constant 
acceleration.  If  a  TBM  does  not  have  constant 
acceleration  during  boost,  an  a  —  0  or  an 
a  —  P  —  7  filter  may  not  provide  valid  estimates 
of  the  TBM’s  position  and  velocity  and,  as  a  re¬ 
sult,  may  not  be  able  to  maintain  track.  TBM 
boost  profiles  assuming  a  constant  thrust  and 
a  constant  rate  of  fuel  consump  'on  show  a  hy- 
perbolically  increasing  acceleration.  This  paper 
presents  and  analyses  a  Kalman  filter  designed 
to  track  a  missile  experiencing  hyperbolically  in¬ 
creasing  acceleration  during  boost  phase.  For 
purposes  of  comparison,  the  tracking  results  of 
an  a  —  /?  filter  are  provided  for  a  general  class  of 
TBMs  representative  of  the  threat  set. 

I.  Introduction 

This  paper  presents  a  Kalman  filter  design 
capable  of  tracking  a  missile  during  boost  phase. 
Boost  phase  tracking  is  becoming  increasingly 
important  based  on  requirements  of  an  early 
launch  doctrine,  the  availability  of  a  timely  non- 
organic  cue,  or  the  requirement  for  missile  typ¬ 
ing.  Since  the  acceleration  of  a  TBM  in  boost 
is  rapidly  increasing,  from  one  g  at  launch  to 


over  8 g  at  burn-out,  a  standard  a  —  3  filter  or 
a  —  /?  — 7  filter  may  not  be  applicable.  Zarchan^l 
discusses  TBM  boost  phase  velocity  and  accel¬ 
eration  characteristics.  The  two  main  assump¬ 
tions  in  Zarchan  are  that  the  thrust  and  fuel  con¬ 
sumption  rate  are  constant.  In  this  paper  sim¬ 
ulated  TBM  trajectories  are  examined  to  show 
that  these  assumptions  are  indeed  valid.  These 
assumptions  are  used  in  the  filter  design  pre¬ 
sented  in  this  paper.  Other  assumptions  used  in 
the  filter  design  are  that  during  boost  the  thrust 
is  much  greater  than  gravity  and  the  angle  of 
attack  is  approximately  zero. 

The  proposed  filter  has  five  states;  position 
and  velocity  states  for  each  dimension  in  the 
pitch  plane  and  one  state  for  total  acceleration. 
Throughout  this  study  it  is  assumed  that  the 
observables  are  limited  to  missile  position.  It 
will  be  shown  that  a  TBM  with  constant  thrust 
and  fuel-consumption-rate  has  a  hyperbolic  ac¬ 
celeration  profile.  It  is  well  known  that  an  a  —  /? 
filter  has  zero  steady  state  estimation  error  when 
tracking  a  target  with  zero  acceleration,  constant 
error  when  tracking  a  target  with  constant  ac¬ 
celeration  and  that  the  a-0  filter  diverges  when 
tracking  a  target  with  ramp  acceleration.  Like¬ 
wise,  ana-,9-7  filter  diverges  when  tracking  a 
target  with  parabolic  acceleration.  Hence,  these 
filters  are  not  appropriate  for  tracking  a  TBM 
in  the  boost  phase.  In  this  paper,  the  proposed 
full  Kalman  filter  will  be  presented  as  well  as  the 
steady-state  version. 
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II.  Derivation  of  Kalman  Filter  Dynamics 

Let  Wtot  be  the  total  weight  of  the  TBM 
at  the  launch,  with  the  launch  time  being  t0  = 
0.  Let  W  denote  the  constant  fuel- consumption- 
rate  of  the  TBM  (a  negative  constant).  Then, 
the  weight  of  the  TBM  at  time  t  is 

W  =W 't  +  Wtot  ■ 

From  F  =  ma,  we  have 


_F  __  T  Tg 

m  w  -t  -f  Wtot  W 


+(Si  ■  g  •  ln(-SV)  +  v0)  ■  t 
+  Si  •  g  •  ( Sw  ■  ln(— Sw)  —  Sw)  +  Po  ■ 
From  (1) 

a  -  (t  +  Sw)  =  —Si  •  g  . 


(3) 


Differentiating, 


fl  4(t  Sw)  "ho  —  0  5 


hence,  from  (1) 


t  + 


Wtot 
W  ! 


a— 


—a 


—a 


(t  +  Sw)  ~Si  •  g  Si  ■  g 


(4) 


(5) 


a 


Also,  substituting  (1)  into  (4)  results  in 


Sl'9'  (t  +  Sw)  ’ 


t  +  Sw )  '  ^  ^ 

where  the  specific  impulse,  Si ,  and  specific  weight, 
Sw,  are  defined  by 


a= 


Sr_g 
(t  +  Sw)2 


=  _J_  (_SrJ_\2 

Si-g  \t  +  i 


Sw) 


(6) 


and 


Si  = 


Sw  = 


-T 
W  ’ 

Wtot 

W 


Equations  (5)  and  (6)  actually  provide  three  dif¬ 
ferent  forms  for  a.  The  time- invariant  form  given 
in  (5)  will  be  used  as  one  of  the  filter  plant  state 
equations. 

Next,  specific  weight  and  impulse  are  com¬ 
puted  in  terms  of  the  TBM  kinematic  variables, 
p,  v  and  a  (and  a).  From  (4), 


T  is  booster  thrust  -  the  dominant  force  by  as¬ 
sumption.  The  constant  thrust  assumption  im¬ 
plies  that  Si  is  a  positive  constant  and  Sw  is  a 
negative  constant.  Both  have  units  of  seconds. 
From  (1),  the  acceleration  of  the  TBM  is  hyper¬ 
bolic.  Clearly,  \Si\  >  |SV|- 

(Evaluating  (1)  at  t  =  0  results  in 


and 


Sw  =  -(l  +  t) 


a  •  (t  +  <SV)  o? 


(7) 


a0 


- T 
W 


9- 


W 


Wtot  Wtot 


Mtot 


which  is  the  correct  initial  acceleration.) 
Integrating  (1)  gives 

v(t)  =  —Si  •  g  •  ln(— (t  +  5V)) 

+  Si  •  g  ■  ln(— Sw)  +  •  (2) 

Integrating  (2)  gives 

p(t)  =  -Srg-((t+Sw)-\n-(-{t+Sw))- (t+Sw)) 


Si  =  =  (8) 

9  a  F 

Equations  (7)  and  (8)  may  be  applied  to  TBM 
data  to  validate  the  constant  thrust  assumption. 
Filter  Plant  State  Equations 
-  One  Dimensional  Case 
Filtering  in  one  dimension  is  the  simplest  case, 
and  will  be  used  for  comparison  with  the  a  — 
filter.  For  motion  in  the  TBM  pitch  plane,  the 
one  dimension  is  along  the  trajectory.  The  fil¬ 
ter  states  are  position,  velocity  and  acceleration. 
The  state  equation  is 


x 

v 


V 

a 


a ‘ 
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The  state  vector  is  X  =  (x,v,a)'.  The  measure¬ 
ment  (output)  equation  is 


z  —  x  . 


(The  process  and  measurement  noise  terms  do 
not  appear  in  these  equations.  They  will  be  in¬ 
cluded  after  discretizing  and  linearizing.)  Dis¬ 
cretizing  gives 

Xk+ 1  =  xfc  +  A  t-vk 
vjt+i  =  vk  +  A t  ■  ak 
a\ 

Ojt+i  —  ak  +  At  •  — —  . 

9  •  Si 

We  follow  the  formulas  for  the  extended  Kalman 
filter  given  in  Anderson  and  Moore®,  section 
8.2.  The  time  update  equations  are 


z*+i| k  =  xk\k  +  A t  •  vk\k 
Vk+i\k  =  F*|*  +  At  •  ak\k 

a? 

Ofc+l|fc  =  +  At  • 

(9) 

for  the  state,  and  for  the  covariance 

Sfc+H*  =  Fk£k\kF'k  +  Qk  •  (10) 

The  matrices  Fk  and  Qk  will  be  defined  subse¬ 
quently.  The  measurement  update  equations  are 

Xk\k  —  Xk\k-i  +  Lk[zk  —  Xk\k-i]  (11) 

S*l* b  =  —  Yjk\k-\Hk[H'kY,k\k-\Hk  +  r/.]-1 

•  H'kXk\k-i  (12) 

where 


Lt  =  +  rt]->  , 


(note  that '  denotes  transpose) 


Fk  = 


1 

0 

0 


At 

1 

0 


0 

At 


dh 

da 


X=Xk\k  J 


(13) 


'  1  At  0 

0  1  At 

0  0  (1  +  2  •  At  •  — —  •  ak\k) 

L  9  ■  oi  J 

and 

H'k  =  [  1  0  0]. 

It  should  be  noted  that  (Hk,Fk)  is  completely 
observable.  The  measurement  noise  term  is  rk. 
It  is  dependent  on  the  radar.  The  3x3  matrix  Qk 
is  derived  from  the  process  noise.  Process  noise 
for  position  and  velocity  could  be  set  to  zero. 
The  process  noise  for  the  acceleration  is  set  to 
account  for  the  deviation  of  Si  from  a  constant 
value.  In  this  case,  the  process  noise  is 

K  =  [o  o 

=  [o  o  (^jW)).AS,].„t  (14) 

V  9  •  Si  J 

where  the  maximum  acceleration  a  max  is  used 
to  make  the  process  noise  and  the  state  indepen¬ 
dent;  {nk}  is  unit  covariance  white  noise.  The 
Q  matrix  is 

Qk  =  E  \pk  ■  pk ] 

'00  0 

0  0  0 

o  0 

Analysis  of  simulated  TBM  data  suggests  that 
some  TBMs  have  a  specific  impulse,  Si,  which 
deviates  from  a  constant  value  more  than  other 
TBMs.  A  Si  would  be  chosen  large  enough  to 
cover  any  TBM.  The  ultimate  values  for  all  of 
the  noise  terms  would  depend  on  the  residual 
(there  is  only  one  since  the  output  a  scalar).  The 
filter  would  give  estimates  for  all  three  states. 
On  line  estimation  of  Si  is  a  topic  for  future 
study. 
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Filter  Plant  State  Equations 

-  Two  Dimensional  Case 

In  this  section,  the  two  dimensional  case  of 
the  above  filter  is  developed.  The  two  dimen¬ 
sions  are  altitude,  z,  and  down  range,  x,  as  de¬ 
fined  by  the  pitch  plane  of  the  TBM.  It  is  as¬ 
sumed  during  boost  that  the  TBM  angle  of  at¬ 
tack  is  zero.  This  assumption  will  simplify  the 
two-dimensional  formulation.  The  flight  path 
angle  is  denoted  by  7;  hence, 


7  =  tan  1(— ) 
vx 


where  vx  =x  and  vz  —z.  From  the  assumption, 


ax  =  cltot  •  cos(7)  =  axoT 
az  =  cltot  •  sin(7)  =  cltot  ■ 


/v2  +  v2 


Ivl  +  vl 


where  cltot  is  the  total  acceleration.  The  state 
equations  are 

x  =  vx 
z  =  vz 

Vx  =  cltot  •  cos(7) 

Vz  =  cltot  •  sin(7) 


q,t  — 


aTOT 

g-  Si  ' 


The  state  vector  is  five  dimensional  in  this  case: 

X  =  (x,  z,  vx,  vx,  cltot)'  • 

Repeating  the  above  steps,  discretizing  the  con¬ 
tinuous  time  state  equations  gives 


in  section  8.2.  The  time  update  equations  are 
%k+l\k  =  %k\k  +  At  •  VXik\k 

2jfc+l|jfc  =  *k\k  +  At  •  Vz<k\k 

Vx,k+l\k  ~  £s,*|A;  +  At  •  O.TOT,k\k  ’  COs(7fc|Jfc) 

vz,k+i\k  —  vz<k\k  +  At  ■  a,TOT,k\k  '  sin(7it|fc) 


aroT,it+i|fc  —  clTot, k\k 


+  At  •  aroT’t|t 


=  fiD(Xk\k)  ■ 

The  linear  expansion  for  the  third,  forth  and  fifth 
components  of  /jd  about  Xk\k,  is  respectively 


=  l  +  At-aroT,fc|fc' 


\vlMk  +  vlMk)^ 


'vl,k \k  +  vZik\k 


=  At- 


\x=xk,k 


*  I  Vx,k\k  ‘  ^Zjk\k 

aroT,k[f  Tjj — .  -2  u, 


a/jg 

da,TOT 


A t  ■  cos(nn) 


2D  a  4-  ~  1  ^xyk\k  *  Vztk\k 

—  =  At-aTOT,k\k •  7^2 - ,  02  N3/2 

x  x=xkik  \yVx,k\k  +  Vz,k\k) 


=  l  +  At-OxOT,fc|jf 


(v2x,k\k  +  vlk\k)3/2 


<V2xMk  +  V2zMk 


Xk+1  =  Xk  +  At  •  vx<k 

Zk+i  =  zk  H"  At  •  vz>k 

Vx,k+ 1  =  VXik  +  At  •  a,TOT,k  ■  COs(7fc) 

vz,k+ 1  =  vz<k  +  At  •  a.TOT,k  *  sin(7fc) 


OTOT.fc+l  =  CLT,k  +  At 


aror,fc 

g-St 


Next,  follow  the  formulas  for  the  extended 
Kalman  filter  given  in  Anderson  and  Moore® 


u JiD 
da,TOT 


=  At  •  sin(7fc|fc) 


=1+2.a  t[^m. 

OdTOT  ~  V  g-Sl  J 

A—-*k  |k 

In  this  case  the  5x5  state  transition  matrix,  Fk, 
defined  by  row  where 
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row  one  is 

(1,0,  At, 0,0)  , 

row  two  is 

(0,1,0,  At,  0) , 

row  three  is 


(0,0, 


row  four  is 


3/|g 


dvx 


3/$ 


x=xk[k 


’  dvz 


x=x 


k\k 


A t  •  cos('y^n))  , 


(0,0, 


3/S 


dvx 


3/S 


X=Xi 


5  (9^ 


At  •  sin(7ifc|fc)) 


and  row  five  is 


(0,0, 0,0, 


3/S 


daxoT 


)• 


The  measurement  matrix  is 


H'k 


1  0  0  0  0 
0  10  0  0 


III.  Numerical  Examples 


A  few  numerical  examples  are  presented  to 
demonstrate  the  performance  of  the  Kalman  fil¬ 
ter  and  to  compare  it  to  an  a  —  f3  filter.  The 
examples  are  all  for  the  one-dimensional  case, 
which  proves  adequate  for  filter  performance  as¬ 
sessment.  The  displacement  dimension  is  slant 
range.  Velocity  and  acceleration  are  total  veloc¬ 
ity  and  acceleration.  The  following  details  con¬ 
cerning  the  a  —  /3  filter  may  be  found  in  Gray- 
Murray®.  The  a  —  f3  filter  equations  are 


(Since  everything  in  this  section  is  discrete  time 
with  no  connection  to  continuous  time,  it  will  be 
convenient  to  use  T  as  the  time  variable  instead 
of  At.) 

a  and  /?  are  related  as  follows 

/?  =  2-(2  — a)  — 4-^(1  — a)  (15) 

and 

£7(i  -  «)  =  (rva2)K2 .  (i6) 

For  comparison  and  to  calculate  a  and  f3 ,  let  the 
one  a  radar  accuracy  be  2  mrad  and  the  range 
from  the  radar  to  the  target  be  250  km.  This 
results  in  crr  —  500  meters.  TBM  acceleration 
ranges  from  about  \g  before  launch  to  a  max¬ 
imum  of  about  8 g  at  burnout,  see  Figure  1(a). 
Hence,  cra  =  80  m/sec2.  The  computed  a  and  (3 
for  various  values  of  T  (must  satisfy  both  (15) 
and  (16)) 


TABLE  1. 


T  (sec) 

a 

£ 

0.25 

0.132 

0.009 

1.0 

0.431 

0.121 

2.0 

0.673 

0.366 

For  a  larger  value  of  T,  the  a  —  (3  filter  weighs 
the  most  recent  data  more  heavily. 

Four  data  sets  (numbered  0-3)  will  be  pro¬ 
cessed  by  the  Kalman  filter  and  the  a  —  (3  fil¬ 
ter.  Data  set  0  is  a  constant  thrust  trajectory 
and  data  sets  1-3  are  simulated  TBM  trajecto¬ 
ries.  The  total  acceleration  profiles  from  launch 
to  burnout  are  given  in  Figure  1(a). 

Next,  compute  the  noise  intensities  for  the 
constant  thrust  filter.  The  measurement  noise 
is  the  same  as  in  the  case  of  the  a—f3  filter,  i.e. 
or  —  500  meters.  From  (14),  the  process  noise 
intensity  is 


•£fc+i|fc+i 

(l-a) 

Xk\k 

_  «fc+i+fc+i 

-PjT 

1-3 

.  ^k\k  _ 

q  = 


TjJ*max)\ 

9-S ]  ) 


•AS'/  . 


(17) 


+ 


a 

NT 


•  Zk+ 1 


From  Figures  1(b)  and  1(c),  Si  =  160  sec,  A  Si  = 
40 sec  and  Sw  =  —  120sec,  and  as  before,  q,max  — 
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80  m/sec2.  Using  these  values  in  (17),  the  pro¬ 
cess  noise  intensities  for  various  values  of  T  are 
given  in  Table  2. 


TABLE  2. 


T(sec) 

0.25 

1.0 

2.0 

q(m/sec2) 

0.24 

0.98 

1.96 

The  errors  at  burn  out  for  data  set  0  given 
by  the  a  —  /?  filter  and  the  Kalman  filter,  assum¬ 
ing  varying  data  measurement  rates  and  no  mea¬ 
surement  noise,  are  given  in  Table  3.  (“ERR” 
denotes  measured  position  minus  estimated  po¬ 
sition,  or  residual.) 


TABLE  3. 


T(sec) 

a  —  P  ERR  (m) 

K.F.  ERR  (m) 

0.25 

389 

0.53 

1 

315 

1.55 

2 

237 

2.08 

The  error  for  the  a  —  (3  filter  decreases  with 
increasing  T.  It  would  be  expected  that  the  op¬ 
posite  would  be  the  case  since  more  data  should 
give  a  better  estimate.  However,  it  is  believed 
that  a  —  fi  filter  behaves  in  this  fashion  because 
of  the  TBM’s  hyperbolically  increasing  acceler¬ 
ation  and  the  fact  that  as  T  increases  the  fil¬ 
ter  weights  more  recent  data  more  heavily,  i.e. 
a  increases  in  magnitude.  This  situation  in  all 
likelihood  would  not  happen  in  the  presence  of 
measurement  noise.  For  example,  when  using 
a  —  0.132  on  the  T  =  1  data,  the  resulting  er¬ 
ror  is  4414  meters,  and  when  use  a  =  0.431  on 
the  T  =  2  data  the  resulting  error  is  1100  me¬ 
ters.  This  deliberate  mismatch  of  a  and  T  sim¬ 
ulates  data  dropout,  which  in  essence  is  a  form 
of  measurement  noise.  Another  reason  may  be 
the  inaccurate  modeling  of  the  system  dynamics 
of  the  a  —  /?  filter.  Figures  2  through  5  give  the 
results  for  the  4  data  sets.  In  each  of  these  fig¬ 
ures,  the  solid  line  represents  T  =  0.25  sec,  the 
dashed  line  represents  T  =  1.0  sec  and  the  dot¬ 
ted  line  represents  T  =  2.0  sec.  Again,  “ERR” 


means  measured  position  minus  estimated  po¬ 
sition.  Figure  6  considers  TBM  data  set  3  as 
does  Figure  5.  However,  in  Figure  6  the  filtering 
starts  51.3  sec  after  launch,  when  this  TBM  is 
at  10km  altitude. 

Kalman  Filter  -  Steady  State  Case 

The  steady  state  Kalman  filter  occurs  when 
the  so-called  “Kalman  gain”,  (13),  is  a  constant. 
An  appropriate  gain  may  be  computed  and  used 
even  when  (13)  is  not  a  constant.  The  result¬ 
ing  filter  would  be  an  approximation  of  the  op¬ 
timal  Kalman  filter.  Needed  is  a  solution  to 
E  =  Efcifc-i  =  to  (10)  and  (12).  This  so¬ 
lution  may  be  computed  recursively  using  (10) 
and  (12).  Since  acceleration  appears  in  these 
equations  and  the  actual  acceleration  varies  dra¬ 
matically  during  boost,  a  nominal  acceleration, 
unom,  must  be  selected.  A  different  nominal 
acceleration  is  used  for  each  measurement  rate. 
Using  data  set  3,  the  error  at  burn  out  for  the 
three  measurement  rates  is  given  in  Table  4. 


TABLE  4. 


T(sec) 

0.25 

1 

2 

aNOM 

8  9 

8  •  9 

3.2  -g 

ERR  (m) 

16.7 

18.1 

18.6 

Unique  to  the  case  of  the  two  second  update 
rate,  the  error  here  actually  oscillates  between 
±30  meters  throughout  the  entire  boost  phase. 
For  these  three  cases,  a  multi-gain  approach  us¬ 
ing  a  small  number  of  gains  may  be  developed 
to  give  better  results  without  going  all  the  way 
to  the  full  Kalman  filter. 

IV.  Conclusions 

This  paper  presents  a  Kalman  filter  which 
has  potential  application  to  tracking  TBMs  dur¬ 
ing  boost.  The  main  assumptions  of  the  filter 
are  that  the  TBM  has  both  a  constant  thrust 
and  fuel  consumption  rate  during  boost.  The 
filter  is  evaluated  and  compared  to  an  a  —  j3  fil¬ 
ter  by  processing  data  from  a  hypothetical  TBM 
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which  fulfills  these  assumptions  and  with  a  gen¬ 
eral  class  of  computer  generated  TBM  trajec¬ 
tories  representative  of  the  threat  set.  The  re¬ 
sults  show  that  while  the  a  —  /?  filter  does  not 
perform  adequately,  the  constant  thrust  Kalman 
filter  does.  An  easy  to  implement  steady  state 
version  of  the  same  Kalman  filter  is  presented. 
This  version  has  adequate  albeit  poorer  perfor¬ 
mance  that  the  full  Kalman  implementation. 
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